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PREFACE 


Enclosed in this final report are three separate Task reports: 'Task I: Kalman Filter Flight 
Software;" Task II: landin g Glldepath Steering Guidance." and Task HI: Kalman Filter Flight 
Software* Data Analysis." Each Task report Is self-contained, with its own Introduction and 

summary sections. 
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1.0 KALMAN FILTER FLIGHT SOFTWARE 


1.1 INTRODUCTION 

Under Task I of its current contract to NASA-Ames, TAU Corporation has designed, coded, and 
tested a Kalman filter to optimally malm use of GPS (in a differential mode) accelerometer data. 
and barometric and radar altimeter measurements. The filter will run in real time onboard the 
SH-3G helicopter, residing in a PDP-11/34M computer, and process raw pseudo and 
deHarange measurements generated by the Magnavax Z-set The purpose of the helicopter 
flight tests is to investigate the extent to which differential GPS (perhaps inertlally or otherwise 
aided) can provide the navigation accuracy required for Category I landings. The current FAA 
Navigation System Accuracy Standards are severe, requiring ±3 meters 2 sigma in vertical 
pnattinn in order to facilitate accuracy comparisons, the filter can be configured In the 
following modes: unaided (Le.. GPS only), GPS-aided by a vertical accelerometer, GPS-aided by 
the accelerometer and a barometric altimeter, and GPS-aided by the accelerometer and a radar 
altimeter. 

In this report, the Kalman filter software Interlaces are described in detail, followed by a 
description of the Kalman filter algorithm, including the basic propagation and measurement 
update equations. The performance of the filter, as exhibited by flight tests conducted to date, 
is t hen reviewed and discussed. Finally, recommendations for further data analysis activities 
and possible enhancements to the Kalman filter algorithm are made. 
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1.2 KALMAN FILTER SOFTWARE INTERFACES 

The interfaces for the TAU Kalman filter software have been previously documented [1.21. The 
relevant tables from [1.2| are repeated herein to make this report more nearly self-contained. 
Table 2-1. abstracted from (11, lists the Kalman filter-related variables required for post-flight 
analysis. Note that program variable names are provided where needed. Table 2-2. abstracted 
from [2], lists the Kalman filter outputs which are required for post flight data analysis. 
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TXBEC (B33DAT) User Time Seconds "User Time" will be used by the 

TAU software to determine when 
data blocks are omitted. 
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Table 2-2. Kalman Filter Data Analysis Requirements 


Item 

Ota 

Free 

Proa ram Name 


CPS Time 

1 

S? 

- 

Variable already recorded by NASA 

Kalman Filter 
State Vector 

9 

SP 

m 

Variable already recorded by NASA 

Baro-Altimeter 
Indicated Alt 

1 

SP 

m 

Variable already recorded by NASA 

Radar- A1 time tar 
Tracking Flag 

1 

SP 

m 

Variable already recorded by NASA 

Radar-Altimeter 
Indicated Alt 

1 

SP 

- 

Variable already recorded by NASA 

Satellite ID 

1 

s? 

- 

Variable already recorded by NASA 

PR Mean 
Residual 

1 

SP 

PRMZSR 


PR Meas 

Residual 

Variance 

1 

SP 

PRMESV 

original page is 

APR. Heas 
Residual 

1 

SP 

DRMZSR 

OF POOR QUALITY 

APR Meaa 
Residual Var 

•. 1 

s? 

DRMESV 

■ 

Baro Altitude 
Meaa Residual 

1 

SP 

BAMZSR 


Baro Altitude 

Meaa Res Var 

1 

SP 

BAMZSV 


Radar Altitude 
Meas Residual 

1 

SP 

BAMZSR 

Note that the radar and baro 
altimeter measurement residuals 
and residual variances have the 

Radar Altitude 
Meaa Res Var 

1 

s? 

BAMZSV 

same program namet this is 
allowable since the measurements 
will never be processed simul- 
taneously. 

Square Root 

Covariance 

Matrix 

45 

SP 

UD(45) 

Upper triangular elements only 

Process Noise 

Covariance 

Matrix 

9 

SP 

Q 

Only of Interest if the Kalman 
filter is adaptive | diagonal 
elements only. 

Already recorded by NASA 

Accelerometer 

3 

SP 

• 

Increments over the lait 1.2 sees 


Incremental 


1.3 K AT. MAN FILTER ALGORITHM DESCRIPTION 

1.3.1 MODES OF OPERATION 

The Kalman filter was designed with an eye toward using low-cost Instrumentation to improve 
the vertical axis error Inherent In the GPS system. Two Instruments were studied: a 
barometric altimeter and a single, vertically mounted accelerometer. It was felt that these 
instruments would supply the maximum worth In vertical axis accuracy enhancement. The 
filter was designed to run In a matrix of modes: unaided; aided by baro-altimeter; aided by 
vertical accelerometer; and aided by both altimeter and accelerometer. A short description of 
operation of the aiding sensors follows. 

1.3.1. 1 Baro-Altlmeter 

The baro-altimeter is subject to a slowly varying, time-correlated bias error due to barometric 
pressure as well as a more complicated bias error due to aerodynamics during turns. The 
latter error source was too difficult to model within the computer data and code memory 
constraints and consequently neglected. The first error source Is estimated In the filter and 
used to compensate the baro-altimeter outputs. 

It should be noted that the filter calibrates the baro-altimeter to "GPS coordinates." Simply 
put. the filter estimates the difference between the GPS altitude and the baro-altimeter altitude, 
then subtracts the difference from the baro-altimeter altitude. Consequently, If the GPS 
altitude is In error, the baro-altimeter is calibrated to agree with the GPS error. The baro- 
altimeter Is used principally because It has much better response than the Z-set in determining 
altitude under dynamic conditions; the altimeter produces a relatively noise-free altitude at 
better than 1 Hz, In contrast to the relatively noisy altitude update from the Z-set at 4.8 second 
Intervals. The altimeter acts as a smoothing Influence on the GPS position, much as a good 
vertical velocity measurement would. 

To prevent the second error source (due to aerodynamics during turns) from contaminating the 
altimeter bias estimatio n, the Alter would not estimate baro bias until the landing approach 
was Initiated. The trajectory was then assumed to be fairly straight with little probability of 
long turns with the associated baro-altimeter dynamics error. The re m ai n ing baro bias was 
expected to be fairly constant during the twenty or thirty seconds of landing approach, long 
enough for the Alter to estimate baro bias and calibrate the altimeter. 

It was noted during the experiment that the barometric altimeter, once calibrated at the airfield 
for the day’s flights, was actually more accurate than non-differential GPS. In practical 
situations, however, the baro-altimeter will not be calibrated at the landing site and the GPS 
receiver will be run In differential mode. Thus, the altimeter will be effectively calibrated In 
real-time to differential GPS altitude, which Is very accurate for the landing approach scenario. 
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1.3.1. 2 Vertical Accelerometer 


A vertical accelerometer was also explored as a means of vertical accuracy enhancement. 
Du rin g landing approach the pitch and roll attitude of the helicopter is fairly stable and near 
level. By mounting the accelerometer near the GPS antenna and inclining it slightly to 
compensate for nominal pitch angle during descent, the veiy precise acceleration 
measurements can be used to smooth the GPS vertical axis. Addition of horizontal 
accelerometers was considered and rejected In the early phases of the experiment because of 
the resulting requirement for heading Information, creating a need to tie Into an all-axis 
attitude system. The concept of all-axis Instrumentation Is veiy sound and must be examined 
in terms of Implementation cost; a single vertical accelerometer at the antenna was Judged to 
be innovative, low-cost, and practical, so this was the main avenue pursued. 

Attitude excursions from the vertical during landing approach were expected to be minor. To 
illustrate the effect of vertical excursion on a vertically mounted accelerometer, a coordinated 
turn at a bank angle of 0.1 radians (5.7 degrees) Induces an acceleration on the vertical 
accelerometer of 1.005 g*s rather than the true acceleration of 1.000 g. This error of roughly 
live cm/sec/s 

sec downward causes the navigation filter to have a small downward velocity bias. This bias 
was deemed acceptable and was to be compensated by adding extra process noise Into the 
accelerometer vertical channel. The extra process noise allows the velocity estimate to recover 
nulcldy from the resulting acceleration mlsmodeling error through the GPS range-rate 
measurements. 

Initial information Indicated that the accelerometer could be calibrated at the beginning of each 
flight. The resulting error was found to be too large in flight test, however, so an accelerometer 
calibration state was proposed. The filter would be able to estimate the accelerometer bias 
during flight. As with the altimeter bias, the estimation was limited to the landing approach, 
because high bank angles in the turns leading up to the approach would cause major vertical 
excursion errors as outlined above and Invalidate the accelerometer bias estimate. 

1.3.2 FILTER PROCESSING EQUATIONS 

Design of the filter was influenced by the severely restrictive code and data memory constraints 
imposed by the real-time hardware. Much of these constraints were removed by definition of a 
leaner interface between Z-set and computer, but this occurred after the filter design had been 
frozen. Shortcuts due to the memory constraints will be noted as they occur; these areas have 
potential for improvement In light of the looser constraints. 

Because memory was more constrained than throughput. It was decided early on to utilize the 
U-D filter software implementation developed by Blerman (3). This not only allows use of 
single precision without numerical Instability In the gain computations but also Is designed for 
minimal data storage. A slight loss of throughput Is experienced; tests on similar filters at TAU 
Indicate the Blerman filter formulation runs roughly 15-20% slower than a simple Kalman 
implementation If both are in single precision. 

The filter state comprises position and receiver clock phase error, velocity and receiver clock 
frequency error, and altimeter and/or accelerometer bias. Table 3.1 defines the variables used 
in the following two sections. Table 3.2 [4| Illustrates the operation of the filter; although the 
Blerman algorithm Is different In equation form. It performs equivalent operation. The filter is 
a two-stage process; the state and covariance Is propagated from measurement to 
measurement through time, and the measurement is Incorporated Into the estimate and the 
covariance is updated. A filter Is well-defined by the propagation and measurement models it 
uses. These models are described below with some rationale as to their development. 
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1.3.2. 1 Filter Propagation Model 

The filter state In the software Is arranged as x, v x . y. vy, z. v z , f. and/or ninth and tenth 
states for the two biases. For convenience the elements of the F, H. Q matrices will be Indexed 
by the state variable rather than the numerical index; for instance, since x is the first state and 
z is the fifth state F(1.5) will be denoted Ffcw). The propagation model for the states Is: 



v z = w 2 , or = z - b z + w z if accelerometer inputs are available 
♦ = f 
f = w^ 

bh = w h 
b z = 0 

where wv=(w x . wy , wz) , w$, and w^ are Independent zero-mean Gaussian random variables of 
spectral density q* Qy. Qz- Q<t»- and qh- respectively. 

The corresponding dynamics matrix F * (805 / 8 x) Is all zeros except for the (x,v x ), (y.vy). (z.vj. 
and fo.v*) elements, which are all 1.0. If accelerometer bias Is also included in the state, the 
(vz.bjJ element Is equal to - 1 . 0 . corresponding to the effect of accelerometer error on vertical 
acceleration. 

As can be seen from the differential equations, the propagation is very linear In nature. For 
this reason a linearized filter was implemented. 

The state Is propagated linearly, and the error covariance also. Covariance propagation is 
performed by 

Pk » < &k Pk-l ♦k* + Ok where 
<D(t) = exfFx) = I + Ft + f2x 2 /2 and 

d>k = 4>(tk*tk-i) = <t>(At); and process noise covariance is described by 
At 

<t»k = / <t»(x)Q <t*t(r) dx 

x = o 

= QAt + (FQ + QFt)(At 2 /2) + (F 2 Q + 2FQF 1 + QF 2 t)(At 2 / 6 ) + .... 

In the Implemented software, an approximation is used for Qk: 

Qk = fi + FAt/ 2 ) Q (I + F^ At/ 2) At . 
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This approximation underestimates the process noise contribution and causes the filter to lag a 
little more than an optimal filter would. Also. If the filter runs for extended periods of time, 
divergence may occur. Both consequences were considered negligible for the relatively short 
mvohred in helicopter landing approach. The purpose of the approximation is to reduce 
the rank of the matrix Ok fro™ eight to four In the unaided filter. Process noise Injection in the 
Blerman algorithm Is done by a rank-one algorithm that must be Invoked as many times as the 
Ok matrix has rank, so the approximate Ok allows roughly half the computation. Since the 
process noise injection is relatively computationally expensive and the software was originally 
very throughput-constrained, the filter was designed toward this compromise. In light of the 
work by Sterling Software and TAU Corporation In reducing throughput and memory 
problems, it Is recommended that the filter be reconfigured slightly to Invoke the full process 
noise matrix. Although the performance during landing will probably not Improve significantly, 
the filter created will have more legacy in non-approach navigation. 

If an accelerometer is present, the vertical velocity Is propagated from time point to time point 
by Integrating the accelerometer output. Instead of the a priori, assumption that the vertical 
velocity Is rou ghl y constant. Having an actual measurement rather than a seat of the pants 
guess gives much higher confidence In the velocity propagation, of course, so the process noise 
uncertainty injected into the vertical channel is typically much lower - decreasing from values 
on the order of meters per second to values on the order of centimeters per second. This allows 
greater averaging over time In the vertical channel, providing a much less noisy error signal 
coming out of the vertical channel. 

To recap the propagation process: 

1. The new measurement time tag is received and At Is computed; 

2. The state estimate Is propagated to the new time. Integrating accelerometer outputs if 
any; 

3. The error covariance Is propagated to the new time; 

4. Process noise Is added Into the forward, right, down (x. y. z) channels and the clock 
phase error channe l independently; also. If an altimeter Is present, the baro- altimeter 
channel as well. 

1. 3.2.2 Filter Measurement Model 

The measurement process computes a measurement update to the state. As. In the Blerman 
structure. As Is stored explicitly In the UD structure In the last elements, numbered (N(N+l)/2 
+ 1) to (N(N+3)/2). A representation of the covariance Is stored In the first N(N+l)/2 elements 
of the UD structure, where N Is the number of states. 

Each call to the Blerman subroutine UMEAS Incorporates the Information In a single scalar 
measurement into the state update and updates the covariance to reflect the additional 
Information. Each scalar measurement must be uncorrelated to the other scalar 
measurements as well as the state estimate. The measurement update equations require as 
Input: 
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the pre-measurement covariance, P; 
the measurement noise covariance, R: 
the measurement gradient vector. H: 
the measurement, AZ; 
the state estimate, A^; 

and output: 

the post-measurement covariance, P: 
the updated state estimate. A&. 

In the NASA implementation, the measurement update is linearized about the post-propagation 
(pre-measurement) state "whole" estimate, as Is done In an extended Kalman filter. At the 
beginning of a measurement cycle (defined as a collection of two or three simultaneous 
measurements) the state "update" estimate In the filter. Ax, is reset to zero at the start, and the 
measurements are linearized by subtracting the nominal measurements which are calculated 
as a function of the whole state estimate. At the end of the measurement process, the state 
update estimate Is added to the state whole estimate In preparation for propagation to the next 
measurement time. 

The Blerman UMEAS subroutine Interface contains the following arguments: 

1. The UD vector structure, containing covariance and state update. Is updated. 

2. The H vector Is input. The nominallzed measurement AZ = Z - h(x) Is stored in the last 
element of H. 

3. The measurement noise variance R Is input. 

4. Two scratch vectors are required. Blerman routines have no Internal vector storage. 

5. The pre-measurement residual variance Is output. (HPHt + R) 

6. A meas urement editing threshold can be Input. This edits a measurement whose pre- 
measurement residual Is greater than the square root of the product of the threshold 
and the pre-measurement residual variance. 

The NASA filter uses three different measurement types: pseudorange, deltarange, and baro- 
altltude. Fa <* fr requires a separate call to UMEAS according to the models described below. 
Accelerometer outputs are considered as part of the process or dynamical system and treated 
deterministically In the propagation model. 

1 .3.2.2. 1 Pseudorange 

The GPS signal Is a code impressed on a carrier signal. The code Is repeated every millisecond, 
and is about 300 km In wavelength. GPS receivers measure code phase with a noise standard 
deviation of about 5 m'Vsec or better with various types of correlators. In the NASA Z-set, 
code phase of one satellite Is measured every 1.2 seconds, with a full cycle four satellites 
requiring 4.8 seconds. Code phase measurement error Is very uncorrelated (white noise) in the 
Z-set. 


Pseudorange Is the basic code phase measurement, and Is usually defined as the sum of the 
transit tim* between GPS receiver and the relative clock error between the two. Some 
definitions account for the various compensatable propagation errors: the Z-set. for Instance. 
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subtracts a simply modeled estimate of tropospheric delay. For filter purposes, however, the 
range and the clock phase error are the only quantities observable through the filter, so they 
are Included In the state. 

Defining range ssv * I I- isv I 

PR = h(x) = ssv + ♦ + noise. 

The measurement gradient vector Is 

H = ( (x-xsv)/ssv. (y-ysv)/ssv. (z-zsv)/ssv. 1. o,o.o.o,o.o). 

The measurement error variance R Is roughly (5m) 2 . 

1.3.2.2.2 Deltarange 

The deltarange is the range-rate, as measured from the carrier, integrated over a short interval 
of time. Carrier tracking loops are much more accurate than code tracking loops, with 
accuracies mostly In the centimeter per second range; the Z-set deltarange seems to be 
quantized at about a foot per second accuracy. In the NASA implementation deltarange Is 
converted to range-rate by dividing by the appropriate time Interval. The measurement 
sequence of the Z-set is to measure the code phase for 980 milliseconds, then turn off the code 
phase lock loop and track carrier phase for roughly 220 milliseconds. Thus the range-rate 
measurement Is not coincidental with the range measurement but rather an average range rate 
over a short period of time lagging the range lags by a fraction of a second. For filter modeling 
purposes the two measurements are assumed to be instantaneous and simultaneous rather 
than average and lagged, a good assumption in terms of the accuracy attainable from the Z-set. 

The measurement Is described by 

DR = h(x) = (y-ysv) t (T-ISV)/ssv + f + noise. 

and the measurement gradient vector Is 

H = (•.•.*.0. (x-xsv)/ssv. (y-ysv)/ssv. (z-zsv)/ssv. i. o.o). 

where the terms denoted by • are very small and negligible In normal navigation (they are 
necessary only In high precision survey applications). 

The measurement noise variance R Is roughly (2m/ 
sec) 2 

1.3.2.2.3 Baro-altltude 

The last measurement, an optional one. Is baro-altltude. The measurement Is simply 
A = h(x) = z + bh + noise 
and the measurement gradient vector is 
H = (0.0, 1 ,0,0,0.0,0, 1 ,0). 

The measurement noise variance R Is less than (lm) 2 . 


12 



The characteristics of the baro-altimeter bias have been noted in the previous sections. The 
filter is Intended to start with little or no a priori knowledge of the baro bias and create an 
estimate of the bias by averaging the difference between the GPS derived altitude and the baro- 
altltude over a long history of readings. It should be noted that the baro-altimeter will be 
calibrated to the GPS altitude whether or not the GPS altitude has large, small, or no error. As 
a consequence, the baro-altimeter is no help to accuracy when the GPS error is large, such as 
is the case when there are no differential corrections. 


Table 3- 1 . Filter Variable Definition 


x = (r, y, f. bfc. bz) 


r 

= 

position, RCS (Forward-right-down) frame 

meters 

♦ 

a 

receiver clock phase error 

meters 

V 

= 

velocity. RCS 

m/sec 

f 

= 

receiver clock frequency error 

m/sec 

bh 

= 

altimeter bias 

meters 

bz 

a 

accelerometer bias 

m/s/s 

PRl 

= 

pseudorange from lth satellite 

meters 

DRi 

= 

deltarange from ith satellite 

m/sec 

hi 


barometric altitude 

meters 

z 

= 

vertical accelerometer output 

m/s/s 

Isv 

= 

satellite position, RCS 

meters 

Ysv 

a 

satellite velocity, RCS 

m/sec 

At 

s 

time since last measurement 

sec 
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Table 3-2. Summary of Continuous-Discrete 
Linearized Kalman Filter 


System Model 
Measurement Model 

itt)»X(x( t ),t)^w(t) ; w(t)~N(fl,Q(t)) 

Ik a hk(*( t k))+Zk k * 1, 2. ; *k ~ N(H. R k) 

Initial Conditions 
Other Assumptions 

x(0)-N(£ o ,p o ) 

E[w(t) vyT J * 0 for all k and all t 
Nominal trajectory x(t) is available 

State Estimate 
Propagation 

Error Covariance 
Propagation 

Jet) »!<T(t),t)+ F(x(t),t)(x(t) -x(t)l 
kt ) - F(x(t).t)P(t)+P(t)FT(x(t),t)+Q(t) 

State Estimate 
Update 

Error Covariance 
Update 

Cain Matrix 

£k( + ) ■ £k(-) + Kk LSc -JudKtk))- Hk(S(t))tik(-) - £(tk) 1 1 
Pk(+)*(I-K k Hic(x(tk))]Pk(-) 

Kfc - Pk(-)H k T(x(tk)) [HkfxftkWPicf-JHicT^t^J+Rkj" 1 

Definitions 

F(x<„,>*» 

•* (u i(t) -so 

tkJ lx(t k )«x(tic) 
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1.4 SUMMARY 


In the absence of aiding sensors, the filter developed for this project was substantially similar 
In structure to the filter internal to the Z-set. The demonstrated improvements in performance 
were probably due to the fact that the Z-set filter Is self-tuning, which always results in 
compromised performance when compared against a filter tuned for the specific dynamical 
system. 

The results shown here represent the status of filter development at the time of the last flight 
test In October 1986. At that flight test the basic eight state filter was still under test In the 
real-time environment Among the aiding sensors, the accelerometers were never fully 
integrated into the filter solution because the residual bias was much more severe than 
originally thought; the baro-altimeter was not exercised because the basic filter was only being 
tested on the last flight; and the differential GPS feature was never fully exercised because of 
lack of confidence In the GPS reference station. 

1 .4. 1 EXPECTED PERFORMANCE 

Theoretically, addition of accelerometer and altimeter either singly or together should aid the 
filter considerably, and. In fact, the data collected during the last series of flight tests looks 
extremely promising. These Instruments are low-noise, quick response sensors to complement 
the noisy, somewhat slower response of the GPS receiver. The result Is a filter solution that 
responds more quickly to real dynamics instead of mistaking the dynamics effects as 
measurement noise. Differential GPS, of course. Is necessary for the project to succeed, since 
standalone GPS Is not sufficiently accurate to perform landing approaches. 

Data collected during the experiment and processed ln-house at NASA has shown that the 
altimeter and accelerometer to show excellent measurement characteristics over short periods 
of time, such as In landing approach. Experiments in differential GPS at TAU show a potential 
of sub-meter static accuracy In the static situations. The combination of instruments should 
produce accuracies on the order of two to three meters (standard deviation) accuracy In the 
vertical axis. 

1 .4.2 RECOMMENDATIONS FOR FURTHER STUDY 

Although not currently In the software, accelerometer bias should be added to the filter. This 
report contains the guidelines in expanding the filter propagation to include the new bias state. 
Because the real-time software Is no longer throughput- or memory-constrained, the expansion 
of the Q matrix to full rank would also be advised. These two additions would improve the 
performance of the filter marginally and allow it to be used In normal flight as well as during 
the landing approach. 

Expansion of the system to include other sensors should also be examined. This study should 
concentrate on sensors that are similar to those found on helicopters, such as level sensors, 
compasses, and Inexpensive accelerometers. The helicopter tested at NASA already contains 
such sensors, so that the expansion of the system requires only extended software and some 
hardware data interfaces. 
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2.1 INTRODUCTION 

This tasrir represents a fairly modest effort to refine the lateral and vertical steering algorithms 
developed under the previous contract. Specifically, the following refinements have been made 
to the steering algorithms, and their effectiveness either flight tested or examined by 
simulation: 

• Modification of the waypoint switching logic to enable handling of more diverse 
flight test scenarios. 

• Further data smoothing, including a second order turn propagation. 

• Compensation of measured delays in the Control Display Indicator (CDI). 

The following section of this report reviews each of these refinements, discussing their 
implementation, simulation based testing, and flight testing (If applicable). In the final section, 
the conclusions which can be drawn from the experiences of flight testing and simulation are 
summarized. 


t 
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2.2 STEERING DISPLAY REFINEMENTS 
2.2. 1 WAYPOINT SWITCHING LOGIC 

The revised waypoint switching logic can best be described by reference to Figure 1. The 
revision was motivated by a desire to Improve the robustness of the steering algorithm, t.e., to 
enhance its performance under off-nominal conditions (e.g., in situations where navigation 
error might be excessive). Basically, five specific regions are established: four of these result in 
an error signal being computed based upon one of the four waypoints on the path; the fifth 
region results In the setting of an error flag. The default dimensions for the square regions are 
0.25 mile on a side. Whenever the center region is entered, a message to return to the Glide 
Path Intercept Point (GPIP) is set. 

Flight test experience with the revised switching logic has proven it to be satisfactory: no 
specific problems worth noting were encountered. Possible future enhancements which were 
not funded as part of this effort were the inclusion of additional tests based upon velocity and 
relating to the effects of solution error on the switch boundaries. Velocity-based testing would 
ensure that the helicopter was heading in the right direction, and Inform the pilot If he was not. 
Such tests could be based upon a simple dot product of the estimated horizontal velocity vector 
with a preferred direction along each leg. Avoidance of an apparent backing up across the 
boundary of a region (induced by solution noise) could be accomplished by only permitting 
transitions to occur in single directions. 



Figure 1. Illustration of Waypoint Switching Logic 
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2.2.2 DATA SMOOTHING 


Additional data smoothing was considered as a means of updating the CDI more frequently 
than once every 1.2 seconds. Specifically, the effectiveness of a second order propagation 
model, which estimated acceleration by numerically differentiating the derived velocity 
estimates, was used to extrapolate the CDI Inputs at 10 Hz. Figure 2 Illustrates the approach. 


ti t 2 t 3 

• < • 

y. y y» y y* y 

y - (y(t 2 ) - y(t 1 ))/t 2 - t x ) t 2 £ t s t 3 


y(t) 


y(t 2 ) + y(t 2 ) 


[t - t 2 ] + y<t - t 2 ) 2 /2 


Figure 2. Second Order Steering Command Propagation 

In the figure, y could represent either the lateral or vertical steering error which is sent to the 
CDI from the Kalman filter, and ti. t2. and t 3 represent the 1.2 second time epochs. Note the 

1.2 second lag Inherent in estimating acceleration (y): derivative information calculated over the 
Interval (ti. tQ) is used over (t2. t^). The effectiveness of this approach was examined using 
TAlTs landing simulation. Results are presented as Figures 3. 4, 5. and 6. The first two 
figures, correspond to a "benign" landing profile, while the second two correspond to a "worst 
case" profile. The distinction between these cases lies in the amount of high frequency 
helicopter motion present By comparison of Figures 3 and 4. It is demonstrated that some 
improvements In the smoothness of the steering display commands can be realized by 
inclusion of the second order propagation term. On the other hand, comparison of Figures 5 
and 6 demonstrates that. In the "worst case" environment, incorporation of the second order 
propagation can degrade the smoothness of the commands. Based on these results, the 
second order terms were not included in the flight tests; in fact, the first order interpolation 
was not included, resulting in an update to the CDI display being computed only once every 

1.2 seconds. 
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Figure 5. Computed Steering Commands for Worst Case Landing 
Profile Using First Order Extrapolation. 
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2.2.3 COMPENSATION FOR MEASURED CDI DELAYS 

Delays inherent in the CDI Imply that the pilot Is using out-of-date Information to steer the 
helicopter. The following development describes a relatively simple approach to compensating 
for this delay by using derivative Information to induce appropriate 'lead" Into the co mm a n ds 
to the CDI. In deriving the compensation equations, it Is assumed that the CDI dynamics can 
be adequately represented by a first order lag. i.e.. Its transfer function Is simply; 


Yo(s) _ 1 

h CDI< 3 ' “ yTfa) i + xa 


(l) 


where y A denotes the CDI Input, and y 0 denotes its output neglecting the nonlinear scaling. 
Ideally, we would Wc» y 0 (In the absence of the display nonlinearlties) to be identical to yi. This 
can be accomplished, at least in theory, by replacing yi by y 1 . a version of yi "advanced" In 
time: 


yl(3) - (1 + Xs ) Yi(s) 

Obviously. If yj(s) is replaced by Y^s) In Equation (1). a transfer function from Yi(s) to Yo(s) 
which Is Identically one results. Practically speaking. Equation (2) can be Implemented using 
the rate (i.e.. velocity) Information computed by the filter 


A A 

yi (t) - y + ty 


(3) 


In addition. If acceleration Information Is generated, the velocity information fed to the CDI 
(since the displayed value Is a function of both position and velocity) can also likewise be 
"advanced": 


y 1 (t) - y + xy < 4 > 

Thus. yl. and yl can be used In place of y and y In generating the display. In an effort to 
compensate for the measured delay (time constant) of the CDI (x). 

The effectiveness of the compensation was examined using the landing simulation, using a 
simple first order lag model (per Equation (1)) for the CDI. 
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Figure 7. Steering Commands for "Perfect" CDI. 

Steering Commands for Position Compensated CDI. 

Steering Commands for Position and Velocity Compensated CDI 
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Simulation results are presented In Figure 7. The steering command plots correspond to an 
expanded time segment during a simulated landing approach with benign dynamics. The solid 
line steering commands appearing In Figure 7 correspond to a "perfect" CDI, Le.. one which 
instantaneously displays the commanded values. The steering commands plotted as dashed 
and dotted lines correspond to a simulated 1 second CDI time constant, with two versions of 
the compensation; In the first version (corresponding to the dashed line), only the position (y) Is 
compensated, while In the second (corresponding to the dotted line), both position (y) and 
velocity (y) are compensated, the latter using the estimated acceleration. Both sets of results 
generally indicate that In the benign dynamic environment, the compensation works very well. 
Note that the one second time delay, corresponding roughly to one time tick. Is barely 
discernible. The only distortion Induced by either form of the compensation is a slight biasing 
of the vertical steering command when only position compensation is utilized. This biasing was 
not deter mine d to be significant. Based on the previous results obtained using acceleration 
estimates in the worst case dynamic environment, the simpler position compensation was 
recommended for flight testing. The effective CDI time constant was measured by NASA to be 
3 secon ds and set as a default value in the software; however, any value (including zero, of 
course) could be set by the operator. Comparable simulation results can be derived for the 
3 second delay but are not Included here. 

Flight testing experience with the compensation has not been encouraging and was generally 
inconclusive. This Is due at least at part to the very large measured delay and to the general 
"noisiness” of the onboard solution. Of course, the compensation will only be effective if the 
onboard filter is tracking the helicopter’s velocity well; any solution error will be scaled by the 
estimated CDI delay and used to drive the display. 
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3.0 SUMMARY- AND CONCLUSIONS 


As discussed In the previous sections, the refinements to the steering algorithm developed 
under this task have exhibited different levels of success in flight testing. The inclusion of a 
second order term In the command propagation was not Incorporated for flight testing due to 
its poor performance In a "noisy" environment. The CDI compensation was exercised In several 
flight tests; however, results were generally Inconclusive due primarily to navigation solution 
error. The most significant accomplishment was the modification of the waypoint switching 
logic, whose performance was successfully demonstrated, and Is highlighted In the following 
paragraph, abstracted from the 8 August letter written by R. P. Denaro. 

Comparison plots from the July 24 flight tests appear as Figures 8 and 9. The plots compare 
the steering display command (darkened line) with the sensed error, and indicate that the 
software is working as desired. Refer to the horizontal plot for the following explanation: 

1. The curve marked "1" Is the aircraft lateral position In the along-path frame. 

2. The curve mar ked "2" is the command from the steering display. 

3. You can usually expect the curves to be "mirror images." (We have corrected for the 
display bias to make these plots). That Is. when the aircraft is left of course, the display 
says "turn right" (shown here). 

4. The display will "peg" when the deviation exceeds a design value (max sealing). 

5. Sudden shifts in position are due to path switching from leg to leg. 

6&7. Note the small steering command, and even apparently wrong sign In the (7) case. This 
is because there is a rate term In the display. In other words. In (6). although the 
helicopter is far left of course, the "cut” or cross track rate Is about right to smoothly 
recapture the path. In (7), the "cut" is too sharp, and the "fly left” command when still 
left of course is to avoid possible overshoot. 

8. The same holds true here. Now we are left of course and Increasing in rate. The 
command is a strong "turn right." 

For the vertical plot, the very same set of observations can be made regarding the performance 
of the steering algorithm and so are not repeated here. 
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Figure 8. Input/Output Comparison for Lateral Steering Command 









3.0 KALMAN FILTER FLIGHT SOFTWAR E DATA ANALYSIS 


3.1 INTRODUCTION 

Under Task III of its current contract to NASA-Ames. TAU Corporation has participated in the 
analysis of the performance of the real-time Kalman filter. The performance has been 
compared to that of the Z-set filter in flight, and post flight comparisons with the laser tracker 
derived "truth” data (in addition to the Z-set) have been completed. Due to the problems and 
delays encountered in the flight test program, only a limited amount of data was made 
available for detailed analysis. Nevertheless, the current status of the flight test data analysis 
effort is discussed herein. 

This report provides a summary of the data analysis work performed on data generated during 
the helicopter test flight on October 30. 1986. 

As can be seen from these preliminary investigations, if properly tuned, an 8-state Kalman 
filter outperforms the Z-set in estimating the position and velocity of the aircraft. 

A copy of the code used to perform the analysis was made available to NASA-Ames so that they 
could maicp additional runs and tune the filter to meet their needs. 

3.2 POST-FLIGHT DATA ANALYSIS 

Prior to the October 30, 1986. helicopter flight, TAU had no laser (truth) data with which to 
help tune the Kalman filter designed for the NASA flights. Thus, assuming that the Z-set. 
against which the filter was being compared in these flights, does a fairly accurate Job of 
tracking the vehicle, the TAU filter was tuned to approximate the Z-set output as closely as 
possible, and the filter parameters were then slightly adjusted to yield smoother results. This 
"tuned” filter was used In the helicopter flight test on October 30, 1986. 

Plots and data analysis results generated by NASA after the October 30 flight show TAU filter 
performance as inadequate. During two approaches, designated here as RUN3 and RUN5, that 
were successfully completed (no apparent equipment failure or satellite loss) the TAU filter 
appears to be outperformed by the Z-set — especially so in the axis of most interest - the 
vertical. 

Having obtained the actual filter parameters used during the flight and the data recorded on 
board the helicopter at the time, TAU set out to try and duplicate the flight results and 
Investigate the cause of poor performance, tuning, or structure. Filter tuning was performed 
on data collected during the period designated as RUN3. 

Figures 1 and 2 show position and velocity errors on an axis-by-axis basis for the Z-set and the 
TAU filter, run with the filter parameters obtained from NASA for the helicopter flight test data 
on October 30. Figure 3 displays the overall position and velocity errors obtained for the run. 
Note that even though this filter is "poorly" tuned, overall position results are somewhat better 
than those produced by the Z-set. and velocity errors are only slightly worse. 
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Various filter parameter combinations were then run to Improve on the performance of the 
Initial tuning. Although different parameter combinations yielded significant Improvements In 
various axes, the "best" overall improvement is presented In Figure 4 through 6. 

Figure 4 shows the position errors for the retimed TAU filter. Note that the performance of the 
TAU filter In the horizontal axes Is significantly better than that of the Z-set. Special notice 
should be taken of the improvement In the vertical obtained with the new tuning. Figure 5 
shows a definite Improvement In the velocity estimation over the original tuning with the new 
filter; note also, that the returned TAU filter shows better performance than the Z-set. 
particularly In the three "excursions" In accuracy over this time period. The 3-dimenslonal. 
spherical performance of the retuned and the originally-tuned TAU filters Is compared in 
Figure 6. 
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Figure 15. Total position and velocity error comparison for the TAU 
filter (highlighted curves) and the Z-set. 
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To v alida te these conclusions on the robustness of the retuning of the TAU filter, that is. to 
determine that the filter was not tuned specifically to the data recorded for RUN3, the retuned 
and ori ginally * tuned filters were rerun on the data period designated as RUN5. Once again the 
tuned TAU filter outperformed the Z-set, In this case by a substantial margin. Overall position 
and velocity errors for the tuned filter for RUN5 data are presented Figure 7. 
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3.3 CONCLUSIONS 


With proper tuning, the TAU filter shows definitely Improved performance over the Z-set. The 
retuning also performed better against a second case. These results validate the performance 
of the TAU filter In meeting or bettering the Z-set performance prior to the addition of aiding 
sensors. 
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October 30 Flight Parameters: 8 - State Filter 
Process Noise (Q-Values): 


Pattern: 


Q(l): 

0.0 m 

0(2): 

0.09 m/sec 

0(3): 

0.0 m 

0(4): 

0.09 m/sec 

0(5): 

0.0 m 

0(6): 

0.09 m/sec 

0(7): 

0.0 nsec 

0(8): 

0.000001 nsec/sec 


Landing: 


0(1): 

0.0 m 

0(2) 

0.09 m/sec 

0(2): 

0.0 m 

0(4) 

0.09 m/sec 

0(5): 

0.0 m 

0(6) 

0.09 m/sec 

0(7): 

0.0 nsec 

0(8): 

0.000001 nsec/sec 


initial state estimates (1 -sigma values): 

STSIG(l): 100.0 m STSIG(2): 10.0 m/sec 

STSIG(3): 100.0 m STSIG(3): 10.0 m/sec 

STSIG(5): 100.0 m STSIG(6): 10.0 m/sec 

STSIG(7): 100.0 nsec STSIG(8): 31.6227766 nsec/sec 

Measurement noise estimates (1-sigma values): 

Pseudorange: 12.0 m 

Deltarange : .8 m/sec 
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Retimed TAU Flight Parameters: 8 - State Filter 
Process Noise (Q-Values): 


Pattern: 


0(1): 

0.0 m 

9(2): 

1.00 m/sec 

90): 

0.0 m 

9(4): 

1.00 m/sec 

0(5): 

0.0 m 

9(6): 

0.01 m/sec 

9(7): 

0.0 nsec 

9(8): 

0.000001 nsec/sec 


Landing: 


9(D: 

0.0 m 

9(2) 

1.00 m/sec 

0(2): 

0.0 m 

9(4) 

1.00 m/sec 

9(5): 

0.0 m 

9(6) 

0.10 m/sec 

9(7): 

0.0 nsec 

9(8): 

0.000001 nsec/sec 


i nitial state estimates (1-slgma values): 


STSIG(l): 

100.0 m 

STSIG(2): 

10.0 

m/sec 

STSIG(3): 

100.0 m 

STSIG(3): 

10.0 

m/sec 

STSIG(5): 

100.0 m 

STSIG(6): 

10.0 

m/sec 

STSIG(7): 

100.0 nsec 

STSIG(8): 

10.0 

nsec/sec 


Measurement noise estimates (1-slgma values): 


Pseudorange: 
Deltarange : * 


36.0 m 
.4 m/sec 
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Retuned TAU Flight Parameters: 9 - State Filter 
Process Noise (Q-Values): 


Pattern: 


Q(l): 

0.0 m 

0(2): 

1.00 m/sec 

0(3): 

0.0 m 

0(4): 

1.00 m/sec 

0(51: 

0.0 m 

0(6): 

0.01 m/sec 

0(7): 

0.0 nsec 

0(8): 

0.000001 nsec/sec 

0(9): 

0.01 m 




Landing: 


0(D: 

0.0 m 

0(2) 

1.01 m/sec 

0(2): 

0.0 m 

0(4) 

1.01 m/sec 

0(5): 

0.0 m 

0(6) 

0. 10 m/sec 

0(7): 

0.0 nsec 

0(8): 

0.000001 nsec/sec 

0(9): 

0.01 




Initial state estimates (1-slgma values): 


STSIG(l): 

100.0 m 

STSIG(2): 

10.0 

m/sec 

STSIG(3): 

100.0 m 

STSIG(4): 

10.0 

m/sec 

STSIG(5): 

100.0 m 

STSIG(6): 

10.0 

m/sec 

STSIG(7): 

100.0 nsec 

STSIG(8): 

10.0 

nsec/sec 

STSIG(9): 

100.0 m 
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Measurement noise estimates (1-slgma values): 

Pseudorange: 

Deltarange: 

Altimeter 


36.0 m 
.4 m/sec 
.1 m 
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Under Tasks I and III of the subject contract, a Kalman filter was developed and flight tested. 
Its performance. In the absence of external sensors, was shown to be Improved over that of the 
Z-set. Pot ential Improvements which could be derived through incorporation of external 
sensors (e.g.. a barometric altimeter and/or a vertical accelerometer) were examined but never 
flight tested. The Task I and HI reports should be consulted for a more complete discussion of 
these results. 

Under Task II, improvements to an existing steering algorithm were Investigated; the relative 
merits of performing additional smoothing in the steering display were examined, and an 
Improved waypoint switching logic was Incorporated. The Task n Report should be consulted 
for a more complete discussion of these results. 
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